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ABSTRACT 


This  thesis  details  the  design  of  the  Naval  Postgraduate  School’s  Flexible  Spacecraft  Simulator 
and  the  first  attempts  at  simulation  and  control  of  the  model.  The  effect  of  flexible  structures  on  the 
attitude  control  of  spacecraft  has  been  a  topic  of  research  for  many  years.  Only  recently  has  the 
technology  to  actually  test  models  and  theory  on  the  ground  been  available.  At  the  Naval 
Postgraduate  School,  an  experimental  testbed  for  research  into  this  area  has  been  constructed.  This 
facility  consists  of  a  satellite  model  with  a  flexible  arm  floating  on  air  pads  to  eliminate  the  effects 
of  friction.  The  Flexible  Spacecraft  Simulator  will  become  fully  operational  in  July,  1991.  A 
mathematical  model  of  the  system  has  been  constructed  and  simulations  of  various  maneuvers  have 
been  run,  utilizing  proportional-derivative  (PD)  control  as  well  as  a  Linear-Quadratic-Gaussian  (LQG) 
compensator.  Results  show  that  both  PD  and  LQG  work  well  for  station  keeping,  but  that  the  LQG 
compensator  is  better  for  slewing  the  arm. 
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I.  INTRODUCTION 


A.  REASON  FOR  ANALYSIS 

The  control  of  flexible  spacecraft  structures  has  been  a  topic  for  research  for 
several  years.  Every  since  Explorer  I  began  it’s  now  famous  tumble,  dynamicists  have 
been  concerned  with  the  effect  flexible  structures  have  on  spacecraft  attitude  and  control. 
In  the  early  days  of  the  space  program,  most  satellites  and  vehicles  consisted  of  rigid 
bodies  with  very  small,  flexible  appjendages.  The  effects  of  these  appendages  were 
considered  mostly  in  terms  of  energy  dissipation  and  in  turn  the  effect  on  attitude 
stability.  Current  spacecraft  have  much  higher  power  requirements  than  in  the  past,  thus 
requiring  larger  solar  arrays.  Dish  antennas  with  substantial  support  structures  are  being 
utilized.  Lighter  structural  materials  are  being  employed  to  save  launch  costs.  Higher 
pointing  accuracies  are  now  required.  All  of  these  factors  contribute  to  a  wider  control 
bandwidth  and  a  lower  structural  frequency  resulting  in  the  possibility  of  control/structure 
interactions.  These  interactions  must  be  known  and  controlled  in  order  to  meet  the 
demands  of  the  next  generation  of  spacecraft. 

In  order  to  determine  the  effect  of  flexibility  on  the  control  of  spacecraft, 
experiments  in  the  design  and  location  of  sensors  and  actuators  as  well  as  the  control 
laws  should  be  conducted.  Conducting  experiments  in  space  is  prohibitively  expensive. 
Simulations  on  computers  are  very  important  and  useful,  but  nonetheless  cannot  be 
proven  accurate  until  actually  implemented.  Conducting  experiments  on  the  ground  in 
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a  gravity-free  environment  is  impossible.  However,  by  proper  design,  two-dimensional 
experiments  may  be  conducted  in  a  frictionless  environment. 

B.  SCOPE  OF  THESIS 

This  thesis  covers  the  design  of  the  Naval  Postgraduate  School’s  Flexible 
Spacecraft  Simulator  or  FSS.  This  experimental  testbed  was  designed  for  the  analysis, 
simulation  and  implementation  of  different  control  systems  for  flexible  spacecraft.  The 
FSS  is  a  two-dimensional  model  of  a  spacecraft  with  a  deployed,  flexible,  support 
structure  for  an  antenna.  The  initial  basic  design  and  choice  of  actuator/ sensors  was 
presented  in  Ward  [Ref.  1].  This  thesis  details  the  integration  of  the  actuator  and 
sensors  as  well  as  the  construction  of  the  model.  The  equations  of  motion  for  the  model 
are  derived,  as  well  as  the  state-space  form  for  digital  implementation.  Finally,  the  first 
attempts  at  simulating  the  motion  and  control  of  the  model  are  presented. 
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11.  EXPERIMENTAL  SETUP 


The  configuration  of  the  experimental  setup  for  the  Flexible  Spacecraft  Simulator, 
(FSS),  is  shown  in  Figure  1. 


Figure  1  Flexible  Spacecraft  Simulator 


A.  SATELLITE  MODEL 

The  satellite  model  consists  of  an  ’L’  shaped  flexible  appendage  attached  to  a 
circular  rigid  body  as  shown  in  Figure  2.  For  this  phase  of  the  experiment,  the  reflector 
and  feed  horn  are  not  used.  The  rigid  body,  denoted  the  "central  body",  is  a  2.22  cm 
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Figure  2:  Satellite  Model 

(7/8  inch)  thick  aluminum  disk  of  0.381  m  (15  inch)  radius.  The  central  body  is 
supported  by  three  aluminum  air  pads  and  restricted  from  translational  motion  by  an  air 
bearing.  The  air  pads  are  spaced  equally  about  the  circumference  of  the  disk  and  are 
inset  into  the  central  body  to  minimize  the  height  of  the  system  above  the  table.  The  air 
bearing  is  connected  to  the  central  body  by  means  of  a  thin,  0.127  mm  (0.005  inch), 
flexible  sheet  of  metal.  This  reduces  the  effect  of  any  torque  about  the  X  or  Y  axis  upon 
the  air  bearing,  which  has  very  little  tilt  stiffness.  The  top  of  the  air  bearing  is 
connected  to  an  I-beam  with  an  adjustable  bracket.  The  bracket  and  associated  movable 
supports  allow  positioning  of  the  model  anywhere  on  the  table’s  surface.  A  cross  sect¬ 
ional  view  of  the  air  support  system  is  shown  in  the  following  figures. 
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Figure  3  Cross  Section  of  Air  Bearing  Mounting  System 


Figure  4  Body  Air  Pad  Mounting  Figure  5  Arm  Air  Pad  Mounting 


The  flexible  appendage,  denoted  the  "arm",  is  two  2.54  cm  (1.0  inch)  wide  strips 
of  aluminum,  1.58  mm  (1/16  inch)  thick,  joined  at  the  elbow  by  a  bracket,  which  also 
supports  an  air  pad.  The  end  point  is  also  a  bracket  for  an  air  pad.  The  "upper  arm" 
is  connected  to  the  central  body  by  means  of  a  clamped  bracket.  "Mass  intensifiers", 
[Ref.  2],  each  with  0.467  kg  (1.03  lb)  of  mass,  are  utilized  to  lower  the  fundamen¬ 
tal  structural  frequency  of  the  arm  to  about  0.13  Hz.  The  mass  intensifiers  are  connected 
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to  the  arm  at  a  single  point,  (see  Figure  2).  This  increases  the  mass  of  the  arm  without 
significantly  stiffening  the  arm.  With  this  setup,  large  structures  with  low  fundamental 
frequencies  can  be  simulated  using  assemblies  of  much  smaller  physical  dimensions.  The 
upper  arm  has  six  mass  intensifiers,  and  the  "lower  arm"  has  two  at  the  end.  One  0.467 
kg  (1.03  lb)  weight  was  added  to  the  "elbow '  bracket  and  two  weights  to  the  end  bracket 
in  order  to  prevent  chatter  in  the  air  pads.  This  combination  of  weights  yields  the 
desired  fundamental  frequency.  6.35  mm  (1/4  inch)  air  line  tubing,  130  PSIG  ♦est,  is 
connected  to  each  air  pad  and  to  the  air  bearing  from  the  air  supply  system.  Appendix 
A  contains  information  concerning  the  mass,  dimensions  and  inertia  properties  of  the 
satellite  model. 

B,  SENSORS 

Four  types  of  sensors  are  employed  on  the  satellite  model; 

1.  A  rotary  variable  differential  transformer,  (RVDT),  is  connected  to  the  rotor  of 
the  air  bearing  by  a  bellows-type  device.  The  RVDT  senses  the  angular  position  of 
the  central  body. 

2.  An  angular  rate  sensor,  (ARS),  is  mounted  on  the  central  body  and  is  used  to 
determine  the  angular  speed  of  the  central  body. 

3.  An  integral  analog  tachometer  is  used  by  the  DC  servo  motor  to  rejxirt  momentum 
wheel  speed. 

4.  Two  accelerometers  are  connected  to  the  endixiint  of  the  lower  arm  and  sense 
accelerations  at  the  endpoint. 

The  manufacturers  specifications  are  given  in  Appendix  B. 
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C.  ACTUATOR 


The  actuator  for  the  FSS,  in  this  phase  of  the  experiment,  is  a  DC  servo  motor 
with  a  10.7  kg  (23.5  lb)  steel  disc  connected  to  the  shaft.  The  motor  and  disc  assembly 
act  as  a  momentum  wheel  for  the  satellite  model.  The  entire  assembly  is  housed  in  a 
separate  aluminum  structure  which  is  then  attached  to  the  central  body.  Figure  6  shows 
the  momentum  wheel  assembly  with  some  of  the  panels  removed  for  clarity.  The  DC 
servo  motor  is  manufactured  by  PMI  and  the  specifications  are  given  in  Appendix  B. 


Monentun  Wheel 


Figure  6:  Momentum  Wheel  Assembly 

The  motor  housing  includes  a  bottom  plate  which  is  connected  to  the  central  body,  a 
thermal  plate  to  which  the  motor  is  mounted,  and  side  panels  which  support  the  thermal 
plate.  The  size  of  the  thermal  plate  is  dictated  by  the  heat  output  of  the  motor  during 
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worst  case  conditions.  The  steel  wheel  is  covered  by  an  aluminum  safety  housing  to 
prevent  injury  during  ojjeration. 

D.  CONTROLLER 

The  control  system  consists  of  a  VAXStation  3100  model  30,  (networked  to  a 
mainframe  VAX),  the  AC- 100  controller,  and  the  associated  software  for  the  AC- 100. 
The  VAXStation  is  a  2.8  MIPS  (million  instructions  per  second)  workstation  configured 
with  eight  Mbytes  of  main  memory,  a  19  inch  color  monitor,  two  104  Mbyte  winchester 
hard  disks,  and  a  mouse.  The  development  software,  which  includes  MATRIXx, 
Autocode,  Interactive  Animation,  RTMONIT  Real-Time  Monitor,  a  ’C’  Compiler  and 
the  Linker/Loader,  is  used  to  create  the  model  of  the  FSS  and  executes  on  the 
VAXStation  under  the  VMS  operating  system.  The  AC-100  Controller  provides  the 
real-time  testbed  execution  environment.  It  consists  of  the  following  standard  hardware 
components  and  their  associated  drivers: 

1 .  An  80386  based  MULTIBUS  II  Application  Processor. 

2.  An  80387  Coprocessor. 

3.  A  Weitek  3167  Coprocessor. 

4.  An  80186  based  MULTIBUS  II  Input/Output  Communications  Processor. 

5.  A/D,  D/A  and  Digital  Data  Translation  DT2402  I/O  Board. 

6.  Two  INX-04  Encoder  and  D/A  Servo  Boards. 

7.  An  External  Trigger  Board  for  the  first  application  processor. 
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For  details  of  the  operating  system  see  the  AC-100  Users  Guide,  [Ref.  3].  The 
simplified  electrical  schematic  for  the  sensors,  actuator  and  controller  is  shown  in 
Figure  7.  The  controller,  servo-amplifier,  power  supply  and  transformer  are  housed  in 
a  19  inch  rack. 


Figure  7  Simplified  Electrical  Schematic 
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m.  THEORETICAL  ANALYSIS 


A.  EQUATIONS  OF  MOTION 

In  order  to  control  the  satellite  model  efficiently,  the  dynamics  of  the  system  must 
be  thoroughly  understood.  The  first  step  is  to  determine  the  equations  of  motion  of  the 
model.  The  hybrid-coordinate  system  of  Ref.  4  is  utilized  in  this  study.  The 
hybrid-coordinate  system  separates  the  model  into  two  distinct  subsystems  which  may  be 
classified  as  either  a  flexible  appendage  or  a  rigid  body.  The  flexible  appendage  is 
assumed  to  be  a  linearly  elastic  structure  for  which  "small"  deformations  may  be 
anticipated  such  that  elastic  stresses  remain  proportional  to  deformations.  The  flexible 
body  is  further  broken  up  into  small  rigid  "subbodies".  In  this  case,  the  flexible 
appendage  is  the  "arm"  and  the  rigid  body  is  the  "central  body".  Each  subbody 
corresponds  to  a  mass  intensifier  or  an  air  pad  bracket  on  the  flexible  arm.  Lagrange’s 
equation  together  with  the  hybrid-coordinate  system  are  used  to  derive  the  equations  of 
motion  of  the  model.  Figure  8  depicts  the  coordinate  system. 

Three  coordinate  axis  are  used  in  the  derivation.  A  fixed,  ("inertial"),  coordinate 
system  is  located  at  the  center  of  rotation  of  the  system,  (constrained  by  the  airbearing 
to  be  the  center  of  the  rigid  body).  The  origin  of  the  second  coordinate  system  is  also 
located  at  the  center  of  rotation,  rotates  with  the  body,  and  is  the  body  coordinate 
system.  The  third  coordinate  system  is  located  at  the  center  of  mass,  (CM)  of  the  system 
and  is  the  CM  coordinate  system.  The  CM  and  body  coordinate  axis  are  parallel  to  one 


10 


Figure  8  Hybrid-Coordinate  System 


another.  Subscript  A  corresponds  to  the  flexible  appendage,  C  to  the  rigid  body. 
Subscript  W  corresponds  to  the  momentum  wheel  system  and  subscript  S  denotes  a 


subbody  on  the  arm.  The  other  symbols  used  in  the  derivation  are  as  follows: 


V  -  VELOCnr  vector  of  an  INFINUISIMAL  mass 

V  -  VELOCITY  OF  CM  OF  SYSTEM 
r  -  POSITION  VECTOR 

Mj  -  TOTAL  MASS 
M  -  MASS 

(3  -  ANGULAR  VELOCITY  VECTOR  OF  SYSTEM 
P  -  POSITION  VECTOR  OF  UNDEFORMED  SUBBODY 
u  -  POSITION  FROM  UNDEFORMED  TO  DEFORMED  SUBBODY 
dfy  -  ANGULAR  POSITION  OF  MOMENTUM  WHEEL 
i|f  -  ROTATION  ABOUT  Z  {FIXED  COORDINATE  SYSTEM) 

I  -  INERTIA 

4>  -  MODAL  COORDINATE 
q  -  MODAL  AMPLITUDE 
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m  -  NUMBER  OF  MODES 
n  -  NUMBER  OF  SUBBODIES 
i  -  i**  MODE 
j  -  y**  SUBBODY 
o).  -  FREQUENCY  OF  i**  MODE 
f  -  DAMPING 

T  -  KINETIC  ENERGY  OF  SYSTEM 
V  -  POTENTIAL  ENERGY  OF  SYSTEM 
L  -  lAGRANGIAN 

In  order  to  form  the  Lagrangian,  the  potential  and  kinetic  energy  of  the  system 
must  be  known.  The  kinetic  energy  is  found  as  follows: 

‘  *  Tw  <‘) 

where  is  the  velocity  of  a  particle  on  body  C  with  respect  to  the  CM  coordinates  and 
is  the  velocity  of  a  particle  on  body  A  with  respect  to  the  CM  coordinates.  The 
position  of  the  center  of  mass  from  the  fixed  coordinate  system  is  denoted  r(cm),  and  T^ 
is  the  kinetic  energy  of  the  system  due  to  the  momentum  wheel.  will  be  due  only  to 
the  rotation  of  the  central  body: 


Vf,  =  r  =  wxfj. 

The  over-dot  denotes  differentiation  of  the  vector  with  respect  to  time. 


(2) 
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will  have  both  rotational  and  translational  terms.  If  the  assumption  is  made 


that: 


■y,dM  = 


y-i 


Vj  may  be  expanded  as  follows: 


(3) 


Vj  =  +  i^xuj 

Expanding  the  dot  product  of  Vj  with  itself  for  each  subbody,  yields: 

VyV.  =  K/(o>xPp  +  VyUj  ^  K/(c3xffp 


(4) 


(5) 


Vj-Vj  =  (C!>xPj)'{u>xPj)  +  {(ixPj)'u  +  (c3xPp*((3xM  ) 

+  u'(CdxPj)  +  u'u  +  u'if^xSp  +  ((3x«p*((3xPp 
+  ((oxUj)’u  +  (QxUj)’(QxUj) 

=  |wxPj^  +  2[(u-(d)xP^.))  +  {C)xPj)’(CixUj)  +  «'((3x«^)] 

+  liip  +  |(3x«^.p 
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Finally,  expanding  the  kinetic  energy  term  due  to  the  momentum  wheel: 


(7) 

where  r(W)  is  the  vector  from  the  origin  of  the  fixed  coordinate  system  to  the  center  of 
the  momentum  wheel. 

Utilizing  the  constraints  of  the  experimental  setup  and  the  superscripts  x,  y  and  z 
to  denote  components  of  a  vector  along  the  CM  coordinate  axis,  the  vector  equations  are 
replaced  by  the  following: 

(3  = 

QxPj  =  (-WPj)!  *  C¥Pj)j 
(^xuj  =  (-WuJ)i  +  C¥Uj)j 

:■  V.-Vj  =  +  iPff]  +  Ujiiij  -  2tp/  -  2t«/)  (8) 

+  +  2YP/  +  2tw/) 

-  u;[^\2p;  + «/)] 

-  «/[t'(2P,’'  +  «/)] 

Noting  that  the  components  of  the  deflection  vector,  u,  may  be  written  as  below: 

“/  =  E4)^<7i(0,  uj  =  (9) 

i=l  i-I 

the  kinetic  energy  of  the  system  may  now  be  written  in  terms  of  the  modal  coordinates 
and  amplitudes,  and  the  systems  angular  velocity: 


14 


(10) 


T  = 


+ 


X  c 


+ 


+ 


^EE  !"/[(♦'/«?  • 


';=!  i=l 


(♦'A' 


*  i’jg^J)  *  i'^K+'P??  *  (4>|;p«?]| 


The  first  term  in  the  brackets  is  the  inertia  of  the  system  about  the  Z  axis  (fixed 
coordinate  system),  minus  the  terms  due  to  the  momentum  wheel  itself,  or; 


4  .  Mr|f(cm)P  »  I JfcMf  *  E*';l^,l' 

;-i 

The  potential  energy  is  now  calculated  using  standard  matrix  notation; 


(11) 


V  =  ^[uvrnu]  [u]  =  mq] 
=  ^[qVimknmq] 


(12) 


where  p(J  is  the  stiffness  matrix.  If  [<j>J  is  normalized  such  that  the  mass  matrix  is  unity, 
then 


[4>]''W[<|)] 


(13) 


where  the  term  on  the  right  is  the  diagonal  matrix  of  natural  frequencies  for  each  mode. 
This  results  in; 


15 


V  =  (of  [q] 

2  ..  J  (14) 

lA  2  2 

■^i-l 

Now  that  the  potential  and  kinetic  energy  of  the  system  have  been  determined,  the 
Lagrangian,  L  =  T  -  V,  may  be  formed.  Lagrange’s  equation  is  written: 


A\Ml]  -  ^  ^  q  (15) 

with  each  generalized  coordinate  represented  by  p;  and  the  generalized  forces  by  g,.  The 
generalized  coordinates  for  this  system  are  0^,  and  each  of  the  qj’s.  The  virtual 
work  principle  may  be  utilized  to  determine  the  Q^'s.  Taking  N  to  be  the  total  number 
of  generalized  coordinates: 


5w  =  =  T6T  -  T60^, 


=  -T 


=  T 


where  T  is  the  torque  applied  by  the  motor.  Lagrange’s  equation  for  each  of  the 
generalized  coordinates  can  now  be  written  as  follows: 


16 


+  M^[24.'p;  ^  2((t.*)Vi » 2*’;?;  *  2((i>|;.)^«,]  t«,)  =  t 


T 


(18) 


EKN)'  *  ('i'i;)1«,  -  -  “?]«, 


(19) 


Equation  (19)  above  is  repeated  for  each  of  the  m  modes.  Assuming  that  the  body  slew 
rate  is  small,  the  nonlinear  terms  will  tend  toward  zero.  Dropping  the  nonlinear  terms 
and  introducing  a  damping  term  for  each  mode  yields  the  following  linearized  equations 
of  motion: 


m 


*  Ea«', 


T  = 


E^q.  +  2Cw^<7.  +  {(ofy.  +  D,t  =  0 


where: 


la  ‘  la*  M^intDp 

o,  =  tWJ  - 

M 

s,  =  Elwj)'  -  wjo'K 

h\ 


(20) 


Again,  the  last  equation  is  repeated  for  each  of  the  m  modes,  resulting  in  m  +  1 
equations  to  be  solved  in  order  to  determine  the  motion  of  the  model.  The  D,  term  is 
designated  the  flexible  coupling  term  and  £,  is  the  modal  mass  term.  If  the  modal 
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coordinates,  are  normalized  such  that  the  mass  matrix  is  unity,  then  will  also  be 
unity.  This  fact  is  used  to  check  the  results  of  the  finite  element  analysis  of  the  arm. 
The  damping  term  f  must  be  assumed  or  experimentally  determined. 

In  order  to  implement  the  equations  on  a  digital  computer,  a  state-space 
representation  of  the  system  of  equations  is  constructed.  The  state-space  format  is: 


X  =  [A]X  ^  [B]U  (21) 

Y  =  [C]X  +  [D]U 

where  X  is  the  vector  of  state  variables,  Y  is  the  output  vector,  and  U  is  the  vector  of 
inputs.  The  matrices  A,  B,  C  and  D  complete  the  description  of  the  system  of  equations 
in  state-space  form.  For  the  FSS,  the  state  variables  are  chosen  to  be: 


X  =  [T,  q^,  t,  q,,  q^,  q^f 

The  output  vector  Y,  is  defined  by  the  sensors  installed  on  the  model: 

Y  =  [T,  wY 

The  input  vector  U  is  the  torque  applied  by  the  motor: 

1/  =  T 


(22) 


(23) 


(24) 
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Rearranging  the  equations  of  motion  to  explicitly  solve  for  the  second  derivative  with 
respect  to  time  of  the  state  variables,  in  terms  of  the  state  variables  and  the  input  torque 
T: 


T  +  E[2C<^,4,  » 

Y  _ 

-  tp,Y 


(25) 


5:[d.(2co,4,  -  -  T 

-  D.  - - - 

-  E 

1=1 

Note  that  if  a  rigid  body  were  assumed,  all  of  the  qj’s  and  4’s  would  be  zero  and  Euler’s 
equation  would  result: 


T 


(26) 
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The  state-space  representation  can  now  be  written  as  follows: 


where;  -  Ep.  f,  F,  =  Dw] 

G,  =  »  D/,.  //,  =  2C0),D, 

J,  -  2Cu,4  + 


(28) 
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The  observation  equation  is  written  below: 


T 

92 


T 

1 

0 

0  . 

0 

0 

0 

0  . 

.  0 

0 

0 

0  . 

.  0 

1 

0 

0  . 

•  0. 

9m 

t 

91 

92 


[OJCD 


(29) 


B.  FINITE  ELEMENT  MODEL  OF  APPENDAGE 

In  order  to  utilize  the  state-space  equations  written  above,  the  mode  shapes  and 
associated  frequencies  must  be  determined.  For  simple  geometries,  the  required  modal 
coordinates  and  natural  frequencies  may  be  solved  for  by  analytical  means.  However, 
for  complex  geometries  such  as  the  FSS,  a  finite  element  analysis  is  required.  The 
interactive  finite  element  program  GIFTS  was  utilized  to  model  the  arm. 

The  appendage  was  modeled  using  beam  elements  with  the  same  cross-section  as 
the  model’s  arm,  and  point  masses  at  the  location  of  the  mass  intensifiers.  Point  masses 
were  also  placed  at  the  elbow  and  tip  to  simulate  the  air  pad  brackets,  air  pads  and 
associated  mas.ses.  The  appendage  was  divided  into  20  nodes,  each  corresponding  to  a 
subbody  in  the  hybrid-coordinate  system.  All  degrees  of  freedom  were  suppressed  at 
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node  one,  (the  central  body  attachment  point),  resulting  in  a  fixed-free  analysis.  The 
rotations  about  the  X  and  Y  axis  were  also  suppressed  for  all  the  nodes,  in  order  to  more 
closely  approximate  the  constraints  imposed  by  the  two  dimensional  model.  The  modal 
analysis  program  was  run  resulting  in  the  desired  modal  coordinates,  normalized  for  a 
unity  mass  matrix,  and  the  associated  natural  frequencies.  The  first  six  mode  shapes  are 
shown  below. 


Figure  9  Mode  Shape  One 
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Figure  10  Mode  Shape  Two 


Figure  1 1  Mode  Shape  Three 
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Figure  13  Mode  Shape  Five 
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Figure  14  Mode  Shape  Six 


The  output  of  the  GIFTS  program  is  given  in  Appendix  C.  Also  given  is  a  Fortran 
program  that  inputs  the  GIFTS  result  and  outputs  the  A  and  B  matrices  of  the  state-space 
system  described  previously,  in  a  form  required  by  MATRIXx  for  use  in  modeling  the 
system. 

As  a  check  on  the  GIFTS  output,  an  experiment  was  conducted  on  the  model  to 
determine  the  fixed-free  natural  frequencies  of  the  arm.  The  model  was  floated  on  the 
air  pads  and  the  central  body  restrained  from  rotation.  The  arm  was  deflected  into  the 
first  mode  shape  and  released.  The  accelerations  at  the  endpoint  were  measured  using 
the  PCB  accelerometer,  (described  in  Appendix  B),  and  a  HP-3561  A  Dynamic  Signal 
Analyzer.  The  accelerometer  was  mounted  perpendicular  to  the  lower  arm.  Table  I 


shows  the  results.  Figure  15  and  Figure  16  show  the  actual  output  of  the  analyzer.  The 
first  two  frequencies  agree  very  well  with  the  GIFTS  data.  Any  frequencies  above  mode 
two  had  too  low  of  an  amplitude  to  be  measured  accurately  and  could  not  be  verified. 
Even  initially  deflecting  the  arm  into  these  mode  shapes  resulted  in  very  low  amplitude 
oscillations,  not  measurable  by  the  installed  equipment. 


TABLE  I  Comparison  of  GIFTS  Data  with  Experimental  Results 


Mode 

Experimental 

GIFTS 

Difference 

one 

0.13  Hz 

0.122  Hz 

-6% 

two 

0.39  Hz 

0.346  Hz 

-11.3% 
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Figure  15  First  Modal  Frequency 


Figure  16  Second  Modal  Frequency 
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rv.  DYNAMIC  SIMULATION 


A.  MATHEMATICAL  MODEL 

As  a  step  in  understanding  the  FSS  and  in  attempting  to  control  it,  a  mathematical 
model  was  constructed.  The  mathematical  model  can  also  be  used  as  an  observer  in  the 
control  system,  since  only  two  of  the  state  variables  may  be  fed  back.  In  constructing 
this  model,  the  number  of  modes,  m,  must  be  truncated  to  some  reasonable  number. 
Modal  truncation  is  a  matter  of  importance  and  demands  some  study.  However,  since 
there  are  no  sensors  or  actuators  on  the  arm  that  are  to  be  used  in  the  present  control 
system,  a  simple  algorithm  was  used.  As  a  minimum,  include  those  modes  that  are 
observed  in  the  motion  of  the  arm,  but  do  not  include  so  many  modes  that  the  resulting 
matrices  will  be  computationally  difficult  and  time  consuming  to  solve.  As  a  result,  the 
first  six  modes  were  used  in  the  simulation.  In  deflecting  the  arm  and  observing  the 
resulting  motion,  the  first  two  modes  appeared  to  be  prevalent,  with  very  little  high 
frequency  motion.  Six  modes  result  in  a  14  by  14  dynamics  matrix  which  may  be 
readily  solved.  The  first  six  modes  also  cover  a  factor  of  100  increase  in  the  natural 
frequencies. 

The  state-space  system  is  generated  by  the  Fortran  program  Form  , (Appendix  C), 
assuming  that  structural  damping  of  the  aluminum  beam  is  two  per  cent  of  critical.  The 
system  of  matrices  is  implemented  on  the  VAX  workstation.  In  order  to  use  the 
simulation  to  run  the  real  time  controller,  the  ’plant’  must  be  discretized.  A  0.01  sec 
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sampling  interval  was  chosen  for  the  discretization,  giving  approximately  ten  samples  per 
period  of  mode  six,  the  highest  frequency  mode  shape  simulated.  A  one  N-m  torque  of 
0. 1  second  duration  was  simulated  to  observe  the  effects  of  the  flexible  appendage.  This 
impulse  was  also  simulated  on  a  rigid  body  with  the  same  mass  and  inertia  properties. 
The  resulting  position  and  rates  are  plotted  in  Figure  17. 


•  «  ••  »«  n  M  >9  40 


Figure  17  Rigid  vs.  Flexible  Model 

These  results  clearly  show  the  impact  of  flexibility  on  attitude  control.  The  rigid  body 
has  a  smooth  transition  to  rotation  about  its  center  of  mass  whereas  the  flexible  model 
begins  to  oscillate,  damping  out  after  several  hundred  seconds.  The  large  variation  in 
body  rates  for  the  flexible  model  is  due  to  the  springing  action  of  the  arm,  as  can  be  seen 
in  Figure  18. 
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In  the  figure  above,  the  position  of  the  arm  with  respect  to  the  main  body  is  plotted  on 
the  X  and  Y  axis.  The  Z  axis  represents  time  in  seconds.  The  arm’s  position  is 
presented  every  two  seconds.  This  format  will  be  used  to  show  the  motion  of  the  arm 
during  a  maneuver. 

The  next  step  is  to  determine  the  control  laws  for  the  flexible  model.  Each  type 
of  control  will  be  subjected  to  a  one  N-m  impulse,  a  five  degree  bias  maneuver,  and  a 
30  degree  counter-clockwise  slew  maneuver  to  determine  viability. 

B.  PROPORTIONAI^DERIVATIVE  CONTROL 

Proportional -derivative  (PD)  control  is  obtained  by  simply  feeding  back  the  body 
position,  and  the  body  rate,  through  a  gain  block.  Three  control  system 
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frequencies  were  chosen:  =  0.05,  0.1  and  0.38  Hz.  The  first  frequency  was  chosen 
to  minimize  control-structural  interactions.  The  second  and  third  were  chosen  to  analyze 
the  effect  of  a  control  system  operating  at  the  first  and  second  mode’s  frequencies. 
Damping,  f ,  was  chosen  as  0.707  of  critical.  One  simulation  was  run  with  f  at  critical 
damping.  The  gains,  K  and  t  in  the  control  law 

=  -K(xd  +  0)  (30) 

are  calculated  by  the  equations,  (see  Ref.  5): 


K 


(31) 


The  values  for  K  and  r  are  given  in  the  table  below. 

TABLE  n 


Designation 

Wc.Hz 

f 

K 

T 

PDIA 

0.05 

0.707 

0.98 

4.48 

PDIB 

0.05 

1.00 

0.98 

6.35 

PD2 

0.10 

0.707 

3.91 

2.25 

PD3 

0.38 

0.707 

56.44 

0.59 

The  impulse  response,  bias  and  slew  maneuvers  for  PDIA  are  shown  in  the 
following  graphs,  (Figure  19,  Figure  20  and  Figure  21).  In  the  graphs,  the  momentum 
wheel  speed  in  RPM,  wheel  torque  in  N-m,  body  position  in  degrees,  and  body  rate  in 
degrees  per  second,  (dps),  are  plotted  versus  time  in  seconds.  PDIB  shows  little 
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difference  from  PDl  A  except  in  the  slew  maneuver.  PD  IB  takes  about  twice  as  long  to 
reach  30  degrees  as  PDl  A,  with  very  little  overshoot,  as  can  be  seen  in  Figure  22. 
Figure  23  shows  the  modal  amplitudes  for  modes  one  and  two,  (ql  and  q2),  for  the  0.05 
Hz  system.  Modes  three  through  six  can  just  be  seen  between  zero  and  ten  seconds  into 
the  slew  maneuver.  Figure  24  shows  the  motion  of  the  arm  during  the  first  25  seconds 
of  the  slew,  while  Figure  25  is  a  "top"  view  of  the  motion  which  shows  the  extent  of 
movement  of  the  arm.  Figure  24  and  Figure  25  is  obtained  by  multiplying  the  modal 
amplitudes  as  a  function  of  time  by  the  modal  coordinates  for  each  node,  summing  over 
all  the  modes  and  adding  this  value  to  the  position  of  the  undeformed  node  with  respect 
to  the  center  of  rotation. 
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Figure  19  Impulse  Response,  PDIA 


Figure  20  Bias  Maneuver,  PDIA 
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Figure  21  Slew  Maneuver,  PDIA 


Figure  22  Slew  Maneuver,  PD)B 
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Figure  23  Slew  Maneuver,  PDIA 


Figure  24  Slew  Maneuver,  PDIA 


Figure  25  Slew  Maneuver,  PDIA 


PD2  show  a  quicker  time  response  to  the  maneuvers  as  expected,  (see  Appendix 
E).  However,  as  can  be  seen  in  Figure  26,  the  amplitude  of  mode  one  has  increased 
about  50%  and  mode  two  has  increased  100%  during  the  slew  maneuver.  Modes  three 
and  four  are  also  beginning  to  show  in  this  figure. 


Figure  26  Slew  Maneuver,  PD2 

PD3  has  an  even  quicker  time  response  and  very  acceptable  control  of  the  main  body, 
(Appendix  E).  Figure  27  presents  the  30  degree  slew  for  PD3.  The  main  body  reaches 
the  30  degree  position  with  no  overshoot  in  about  two  seconds.  The  20  N-m  wheel 
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torque  required  is  within  the  capabilities  of  the  motor.  Figure  28  shows  that  the  modal 
amplitudes,  (modes  one  and  two),  have  increased  by  a  factor  of  three  over  the  amplitudes 
in  PDl,  resulting  in  the  highly  undesirable  whip-like  motion  of  the  arm  shown  in 
Figure  29  and  Figure  30.  Note  that  the  torque  on  the  body  from  the  oscillations  of  the 
arm  is  controllable  by  the  momentum  wheel,  even  at  these  amplitudes. 
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Figure  27  Slew  Maneuver,  PD3 
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Figure  28  Slew  Maneuver,  PD3 


Figure  29  Slew  Maneuver,  PD3 


Figure  30  Slew  Maneuver,  PD3 


C.  LINEAR-QUADRATIC-GAUSSIAN  COMPENSATOR 

The  second  type  of  control  system  studied  was  the  linear-quadratic- gaussian  or 
LQG  comp)ensator.  The  LQG  compensator  is  formed  from  a  linear  regulator  and  a 
Kalman  filter  estimator.  The  regulator  design  assumes  full-state  feedback,  and  a 
controllable  system.  The  controllability  grammian,  [Ref.  6],  for  the  system  of 
matrices  is  computed  using  MATRIXx  and  is  found  to  be  of  full  rank,  ensuring  controlla¬ 
bility,  assuming  the  system  to  be  dynamically  stable  and  time-invariant.  The  optimal 
gains  are  calculated  by  minimizing  the  cost  function: 

cost  =  f“(x'R^x  +  u'R^u)dt  (32) 

where  R„  is  the  state  weighting  matrix  and  R„u  is  the  input  weighting  matrix.  The  gains 
are  determined  by  first  solving  for  M  in  the  algebraic  Ricatti  equation,  [Ref.  6]: 

0  ^  MA  ^  A'M  -  MBR^B'M  +  R^  (33) 

where  A  and  B  are  the  system  dynamic  and  control  input  matrices  respectively.  The 
optimum  gain  is  now  given  by: 

G  =  R^B'M  (34) 

These  functions  are  computed  by  the  command  REGULATOR,  in  the  MATRIXx  Control 
Design  Module,  [Ref.  7]. 

The  Kalman  filter  design  is  performed  in  much  the  same  way,  utilizing  the  duality 
theorem  for  estimators  and  regulators.  However,  instead  of  state  and  input  weighting 
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matrices,  R„  and  Ryy,  the  state  and  observation  noise  intensities,  Q„  and  Q,,,  must  be 
determined.  For  a  linear  time-invariant  system, 


X  =  Ax  +  Bu  +  Fw  (35) 

y  =  Cx  +  Du  +  V 

where  w  is  the  input  disturbance,  F  is  the  input  disturbance  matrix,  and  v  is  the 
measurement  noise,  the  noise  intensity  matrices  are  defined,  [Ref. 7]: 


W)v'(T))  =  <?^6(f-T) 

£(FH<r)v'(T))  = 


where  E  is  the  expectation  operator  and  B  is  the  delta  function.  The  noises,  w  and  v,  are 
assumed  to  be  white  with  zero  mean.  For  the  FSS,  the  assumption  is  made  that  the  only 
disturbance  is  a  random  torque  of  0.0 1  N-m  amplitude  and  thus: 

<?„  =  B(0.01)B'  (37) 

Qyy  is  assumed  to  be  a  two  by  two  diagonal  matrix  with  the  first  term  on  the  diagonal 
corresponding  to  the  noise  from  the  RVDT  and  the  second  term  corresponding  to  the 
noise  from  the  angular  rate  sensor.  The  best  available  estimate  of  noise  is  used  until 
such  time  that  the  experimental  value  can  be  used.  Thus: 


2E-6  0 

0  6E-6 


(38) 


The  Ricatti  equation  is  solved  again  and  the  gains  computed  as  before,  however  the  gain 
matrix  will  now  be  a  14  by  two  since  there  will  be  two  inputs  into  the  estimator,  (the  two 
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outputs  of  the  system).  The  estimator  gains  are  computed  in  MATRIXx  with  the 
command  ESTIMATOR  in  the  Control  Design  Module. 

The  compensator  is  now  synthesized  using  the  A,  B,  C  and  D  matrices  of  the 
system  and  the  regulator  and  estimator  gains,  Kr  and  Ke  respectively.  The  form  of  the 
compensator  is  as  follows: 


\A  -  Ke*C  -  (B  -  Ke*D)  \Kl_] 

SC  =  (39) 

I  0  . 

where  SC  is  the  compensator  system  matrix.  The  LQGCOMP  command  in  the  Control 
Design  Module  of  MATRIXx  accomplishes  this  formation.  The  block  diagram  for  the 
control  system,  as  well  as  the  points  at  which  inputs  and  outputs  aru  taken,  is  given  in 
Figure  31. 


Figure  31  Block  Diagram  of  Control  System 
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All  that  remains  is  to  determine  R„  and  R„u.  R„  is  a  14  by  14  matrix  and  is 
assumed  to  be  diagonal,  with  each  term  on  the  diagonal  corresponding  to  a  state.  R„„ 
is  simply  a  scaler,  since  there  is  only  one  input.  Positioning  the  main  body  is  the 
primary  concern  of  this  thesis  and  therefore  the  first  term  on  the  diagoiial,  which 
corresponds  to  body  position  is  set  to  one,  and  all  others  are  set  to  zero.  R„„  is 
assigned  0.001  in  order  to  prevent  exceeding  the  design  limits  of  the  motor.  The  systems 
response  to  the  impulse  disturbance  and  bias  maneuvers  are  given  in  Appendix  E.  These 
figures  show  an  acceptable  response  for  the  body  with  a  0.23  degree  error  during  the 
impulse  and  three  seconds  required  for  the  bias  maneuver.  The  arm  shows  little 
deflection  during  the  impulse  and  acceptable  oscillations  during  the  bias  maneuver. 
Figure  32  shows  the  response  to  a  30  degree  slew.  The  body  reaches  the  desired 
position  in  about  three  seconds  and  the  motor  torque  is  well  within  limits.  Examination 
of  Figure  33  reveals  that  modes  one  and  two  are  highly  excited  during  the  slew,  and 
modes  three  and  four  moderately  excited.  The  resulting  extreme  motion  of  the 
appendage  is  shown  in  Figure  34  and  Figure  35  .  This  motion  would  more  than  likely 
result  in  permanent  deformation  of  the  beam. 
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Figure  32  Slew  Maneuver,  Cl 
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Figure  33  Slew  Maneuver,  Cl 


Figure  34  Slew  Maneuver,  Cl 


A  second  means  of  control  is  required  for  large  angle  maneuvers.  The  modal 
amplitude  graph  indicates  that  by  controlling  ql  and  q2,  acceptable  results  could  be 
achieved.  An  attempt  to  do  this  is  made  by  varying  the  weights  on  the  'Ir,  'if,  ql,  ql, 
q2,  and  q2,  as  well  as  the  weight  on  the  torque  input.  TABLE  III  indicates  values  used 
for  the  significant  results.  The  figures  for  C2  through  C7  are  given  in  Appendix  E. 


TABLE  III  Weighting  Factors 


R„ 

Ruu 

Designation 

D 

ql 

q2 

B 

ql 

q2 

T 

Cl 

B 

0 

0 

0 

0 

0 

.001 

C2 

B 

10 

10 

0 

0 

0 

0.1 

C3 

B 

10" 

10" 

0 

0 

0 

0.1 

C4 

1 

0 

0 

0 

1 

1 

0.1 

C5 

B 

0 

0 

0 

10" 

10" 

0.1 

C6 

B 

0 

0 

1 

0 

0 

0.1 

C7 

B 

0 

0 

1 

0.2 

0.2 

100 

C8 

B 

0 

0 

1 

0.7 

0.5 

1000 
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C8  shows  the  best  results  for  the  optimum  controller  for  the  slew  maneuver.  The 
following  four  figures  show  the  response  of  the  central  body  and  the  flexible  arm.  The 
slew  rate  is  slow,  but  this  is  required  in  order  to  prevent  exciting  the  first  and  second 
modes  of  the  arm. 
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Figure  37  Slew  Maneuver,  C8 


As  a  comparison  of  the  PD  controller  and  LQG  compensator,  an  on-orbit  mode  was 
designed  to  maintain  0.05  degree  pointing  accuracy  of  the  central  body.  For  the  PD 
controller,  the  gains,  K  and  t  were  computed  using  the  equations  found  on  page  139  of 
Ref.  5,  and  assuming  that  the  model  could  be  treated  as  rigid.  The  inertia  of  the  system 
about  the  Z  axis,  (fixed),  was  used  in  the  calculations.  The  required  gains  are:  K  = 
179.3,  T  =  84.3.  For  the  LQG  compensator,  R„  was  the  same  as  used  for  Cl,  but  R„u 
was  set  at  10*  in  order  to  maintain  0.05  degree  accuracy.  was  arrived  at  by  trial  and 
error.  The  results  are  presented  in  Figure  40  through  Figure  43.  Botii  controllers 
control  well  in  the  on-orbit  mode  with  only  a  millimeter  movement  in  the  endpoint. 
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V.  CONCLUSIONS 


The  Flexible  Spacecraft  Simulator,  (FSS),  is  fully  assembled  and  should  become 
operational  within  the  next  few  weeks.  The  initial  operational  configuration  has  sensors 
and  an  actuator  on  the  central  body.  A  picture  of  the  present  setup  is  provided  in 
Appendix  A.  With  this  Phase  I  setup,  actual  experiments  into  the  effect  of  flexible 
spacecraft  structures  on  attitude  dynamics  and  control  can  be  carried  out. 

Both  the  PD  control  and  the  LQG  compensator  show  that  on-orbit  control  of  the 
central  body  is  readily  achievable.  Control  of  the  antenna  endpoint  is  not  as  good,  with 
the  maximum  deflection  reaching  about  one  mm  for  a  one  N-m  impulse  disturbance. 
Slewing  the  central  body  at  a  fairly  high  rate  of  speed  is  possible,  but  at  the  expense  of 
severe  oscillations  of  the  arm,  and  at  some  point,  damage  to  the  arm  itself.  The 
oscillations  imposed  by  the  rapid  slew  do  not  damp  out  quickly,  but  the  torque  imposed 
on  the  central  body  is  small  enough  that  the  actuator  can  still  maintain  the  position  of  the 
body.  Results  show  that  the  LQG  compensator  is  better  for  slewing  the  arm,  but  in 
order  to  use  this  type  of  control,  two  compensators  will  be  required.  One  compensator 
will  be  set  up  for  the  on-orbit  mode,  and  one  for  slewing  the  satellite  model. 
Satisfactory  control  can  be  achieved,  but  the  maximum  slew  rate  will  be  about  one 
deg/sec. 
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A.  RECOMMENDATIONS  FOR  FURTHER  STUDY 


Experimental  verification  of  the  mode  shapes  and  frequencies  as  well  as  the 
damping  coefficient  should  be  accomplished  as  soon  as  the  instrumentation  is  available. 
Also,  further  work  is  required  in  optimizing  the  control  design  for  the  slew  maneuver 
using  only  the  single  actuator.  Control  of  the  central  body  is  readily  achievable  using 
both  PD  and  LQG  control,  but  at  the  expense  of  moderate  to  severe  oscillations  of  the 
arm.  Attempts  to  control  the  arm  using  the  LQG  compensator  and  weighting  the  time 
rate  of  change  of  the  first  two  mode  shapes  result  in  minimizing  the  amplitude  of  the 
oscillations.  However,  control  of  the  position  of  the  central  body  is  then  lost.  Weighting 
both  the  arm  and  the  central  body  results  in  a  slow  maneuver  of  about  one  deg/sec  and 
low  amplitude  oscillations  of  the  arm.  The  magnitude  of  the  time  rate  of  change  of  the 
acceleration,  otiierwise  known  as  "jerk",  and  more  importantly,  the  length  of  time  that 
the  jerk  is  applied  appear  to  have  the  most  effect  on  the  amplitude  of  the  oscillations. 
By  programming  the  body  rate  during  the  maneuver  such  that  this  effect  is  minimized, 
better  control  of  the  arm  and  a  more  rapid  slew  might  be  achieved. 

The  FSS  can  be  easily  expanded  to  using  piezoelectric  sensors  and  actuators  on  the 
flexible  arm.  In  follow  on  phases,  thrusters  may  be  added  to  the  central  body,  as  well 
as  liquid  tanks.  Endpoint  sensing  will  be  added  and  control  of  the  arm’s  endpoint 
attempted.  Deployment  of  space  structures,  such  as  antennas  and  solar  arrays,  can  be 
tested.  By  adding  a  motor  to  the  elbow  and  endpoint,  stace  robotics  experiments  may 
be  attempted.  The  FSS  will  be  an  extremely  useful  research  and  teaching  tool  in  the 
challenging  area  of  attitude  dynamics  and  control.  [Ref.  8] 
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The  design  of  the  experimental  setup  to  simulate  spacecraft  structural/control 
interactions  has  been  challenging.  The  current  design  simulates  the  classical  control 
method  where  sensors  and  actuators  are  located  on  the  central  body.  However,  it  can 
be  easily  extended  to  simulate  control  configurations  where  the  sensors  and  actuators  are 
distributed  throughout  the  model.  It  is  a  versatile  testbed  for  the  investigation  of 
techniques  in  dynamics  and  control  of  flexible  spacecraft.  More  importantly,  it  allows 
experimental  verification  of  analytical  results  prior  to  implementation  on  flight  spacecraft. 
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APPENDIX  A 


Figure  44  Flexible  Spacecraft  Simulator 
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Figure  45  Key  to  Inertia  Spreadsheet 


55 


'leri  i)5e  maiefia! 


IJi' 

122 

1X1 

Ixx 

In 

cylinder 

alum  nun 

cylmuer 

iiuinnun 

cylinder 

air  pad 

cylinder 

aluiiinpii 

cylinder 

air  pad 

cylinder 

alurmun 

cylinder 

air  pad 

(joughnul 

alum  nun 

dondnnul 

aiuinnufi 

dougMiii 

atumnuffi 

cylinder 

steel 

cylinder 

ffiCtO' 

cylinder 

ai'  pad 

cylinder 

air  pad 

nime 

aiuifiinun 

piale 

alum  null 

plate 

alum  nun 

plate 

aiufiinun 

plate 

alufiinun 

plate 

aiuninun 

plate 

aluii<nun 

plate 

ilutiinirn 

piale 

alum  nun 

plate 

alum  nun 

plate 

iiufxnun 

plate 

alum  nun 

plate 

aiueiinun 

plate 

aiuviinun 

ptatp 

jlvuinun 

special 

aUmnun 

pia'e 

a  lue^'  nun 

plate 

a  luifii  nun 

plate 

aiurTuiii 

0  00 

6,313 

6,313 

0  00 

9  39 

0  03 

16  60 

lU^j 

0  02 

9  39 

10  60 

0.00 

9.39 

0  03 

10  60 

).16 

7  16 

1  IS 

1  76 

0  41 

0  44 

311  64 

3,296 

119  14 

2,342 

214  24 

296  9? 

ijm^ 

0  5S 

38  08 

24.13 

-90.00 

20  35 

91  90 

0  11 

53  69 

0  60 

41  19 

15  00 

HQ 

41  19 

45  00 

41  19 

15  00 

23  02 

103  30 

15  00 

QHQ 

369  47 

15  00 

)  0? 

124  56 

15  00 

)  02 

124  56 

15  00 

9  03 

15  00 

9  03 

15  00 

0  0? 

46  1? 

15  00 

0  02 

46  12 

15  00 

24  61 

342  92 

SI  90 

0  11 

53  69 

SO  DO 

0  14 

20  35 

SO  DO 

0  10 

7  01 

3,302  3,302 


0-01 


0.02  1V40 


3  09  3  09 


56 


J5 

8 

65 

■y 

C 

?:■ 

r. 

u 

03 

Q 

01 

8 

I3 

0 

07 

0,56  piale 

0? 

'jS 

'jG 

?34 

69 

63 

63 

C 

7^ 

0 

D7 

0 

?4 

■  7 

66 

0 

05 

7  00  plate 

03 

3G 

4  h 

C6 

6 

IT 

0 

09 

G 

00 

0 

04 

9 

55 

■  1 

68 

3,86  plate 

24 

6  3 

36 

63 

30 

0? 

■0 

07 

C 

06 

0 

04 

7 

43 

6 

04 

BilSm 

25 

A 

Aj 

■  3 

03 

A 

57 

■0 

01 

0 

01 

0 

01 

3 

73 

4 

44 

3,86  plate 

06 

2 

66 

5 

6C 

,  T 

04 

0 

01 

0 

00 

0 

O' 

■5 

45 

1 

98 

3  86  p 1  ale 

27 

0 

5 

‘3 

6: 

0 

M 

C 

03 

C 

OC 

0 

01 

■  13 

05 

0 

14 

3  86  plate 

20 

-1  p 

0' 

1  1 

85 

6 

71 

C 

fi  7 

0 

01 

0 

01 

11 

53 

6 

50 

3  86  plate 

29 

-  79 

98 

■  151 

31 

40 

54 

0 

15 

0 

04 

0 

08 

- 14 

13 

3 

79 

7 , 00  spec la I 

30 

c’ 

G5 

0 

CG 

0 

OC 

■  c 

CO 

-0 

D1 

0 

DO 

13 

89 

■7 

40 

0  00  plate 

31 

8 

79 

C 

68 

-  G 

35 

-0 

01 

•0 

01 

0 

00 

10 

57 

7 

06 

0  56  plate 

30 

J 

0? 

0 

2  A 

■ 

4? 

0 

00 

■0 

01 

0 

00 

A 

00 

-B 

93 

0  56  pi  ate 

33 

57 


Figure  48  Inertia  of  System,  cont. 
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Figure  49  Inertia  of  System,  cont 


Figure  50  Inertia  of  System,  cont 
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APPENDIX  B 


A.  ROTARY  VARIABLE  DIFFERENTIAL  TRANSFORMER 

1.  Manufacturer  -  Schaevitz  Engineering 

2.  Model  -  R30D 

3.  Scale  Factor  -  0. 126  VDC/degree 

4.  Linearity  -  0.16% 


B.  ANGULAR  RATE  SENSOR 

1.  Manufacturer  -  Watson  Industries,  Inc 

2.  Model  -  ARS-C121-1A 

3.  Sensitivity  -  30  deg/sec  full  scale 

4.  Frequency  Response  -  DC  to  50  Hz 


C.  ACCELEROMETER 

1 .  Manufacturer  -  PCB  Piezotronics,  Inc 

2.  Model  -  302 A02 

3.  Resolution  -  0.01  g 

4.  Frequency  Range  (±  5%)  -  0.05  to  5000  Hz 
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D.  DC  SERVO  MOTOR 


1 .  Manutacturer  -  PMI  Motion  Technologies 

2.  Model  -  JR16M4CH/F9T 

3.  Horsepower  -  1.4  HP 

4.  Peak  Torque  -  5307.2  oz-in 

5.  Peak  Acceleration  without  Load  -  63.2  KRAD/SEC^ 

6.  Cogging  Torque  -  0 

7.  Terminal  Voltage  -  128.7  VDC 

8.  Current  -  9.55  amp 

9.  Power  Output  -  1049.5  Watts 

10.  Torque  Constant  -  52.77  oz-in/amp 

11.  Mechanical  Time  Constant,  no  load  -  3.15  msec 

12.  Electrical  Time  Constant  -  <  0.14  msec 

13.  Speed  Regulation  -  0.36  RPM/oz-in 

14.  Motor  Diameter  -  7.38  in 

15.  Motor  Length  -  4.50  in 

16.  Motor  Weight  -  17.50  lb 
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APPENDIX  C 


A.  GIFTS  OUTPUT 


•B:  arms 

MODE 

FREQ 

9-MAY-91 

FREQUENCIES 

EIGV 

1 

1.21602E-01 

5.83767D-01 

2 

3.46436E-01 

4.73812D+00 

3 

2.65877E+00 

2.79075D+02 

4 

3.55180E+00 

4.98031D+02 

5 

6. 12919E+00 

1.48308D+03 

6 

1.66874E+01 

1.09935D+04 

PAGE  1 


JOB: arms  9- 

-MAY-91  MODE  1  —  1.216E-01  CPS  IS: 39: 19 

DISPLACEMENT  INFORMATION 

PAGE 

POINT 

U 

V 

W 

RX 

RY 

RZ 

1 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+OO 

O.OOOE+OO 

2 

1.390E-08 

1.917E-03 

1.114E-36 

O.OOOE+00 

O.OOOE+OO 

7.S01E-02 

3 

1.S29E-07 

2.028E-01 

1.499E-3S 

O.OOOE+00 

O.OOOE+OO 

6.693E-01 

4 

1.824E-07 

2.801E-01 

2.078E-3S 

O.OOOE+00 

O.OOOE+OO 

7.612E-01 

S 

9.730E-02 

2.801E-01 

2.726E-35 

O.OOOE+00 

O.OOOE+OO 

8.486E-01 

6 

S.192E-01 

2.801E-01 

3.S67E-3S 

O.OOOE+00 

O.OOOE+OO 

1.008E+00 

7 

6.219E-01 

2.801E-01 

3.804E-35 

O.OOOE+00 

O.OOOE+OO 

1.012E+00 

8 

3. 127E-08 

9.SS2E-03 

2.934E-36 

O.OOOE+00 

O.OOOE+OO 

1.647E-01 

9 

4.86SE-08 

2.274E-02 

4.733E-36 

O.OOOE+00 

O.OOOE+OO 

2.499E-01 

10 

6.602E-08 

4.120E-02 

6.498E-36 

O.OOOE+00 

O.OOOE+OO 

3.307E-01 

11 

8.339E-08 

6.465E-02 

8.218E-36 

O.OOOE+00 

O.OOOE+OO 

4.071E-01 

12 

1.008E-07 

9.281E-02 

9.936E-36 

O.OOOE+00 

O.OOOE+OO 

4.791E-01 

13 

1. 181E-07 

1.2S4E-01 

1:165E-3S 

O.OOOE+00 

O.OOOE+OO 

5.468E-01 

14 

1.3SSE-07 

1.622E-01 

1.337E-3S 

O.OOOE+OO 

O.OOOE+OO 

6.101E-01 

IS 

1.S24E-01 

2.801E-01 

2.8S1E-3S 

O.OOOE+00 

O.OOOE+OO 

8.869E-01 

16 

2,098E-01 

2.801E-01 

2.97SE-35 

O.OOOE+OO 

O.OOOE+OO 

9.201F-01 

17 

2.692E-01 

2.801E-01 

3,099E-3S 

O.OOOE+OO 

O.OOOE+OO 

9.479E-01 

18 

3.301E-01 

2.801E-01 

3.223E-3S 

O.OOOE+OO 

O.OOOE+OO 

9.706E-01 

19 

3.923E-01 

2.801E-01 

3.346E-3S 

O.OOOE+OO 

O.OOOE+OO 

9.880E-01 

20 

4.SSSE-01 

2.801E-01 

3.469E-3S 

O.OOOE+OO 

O.OOOE+OO 

l.OOOE+00 

JOB: arms  9- 

-MAY-91  MODE  2  —  3.464S-01  CPS  IS: 39: 19 

DISPLACEMENT  INFORMATION 

PAGE 

POINT 

U 

V 

W 

RX 

RY 

RZ 

1 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+OO 

O.OOOE+OO 

O.OOOE+OO 

2 

6.883E-08 

-6.424E-03 

-3.061E-28 

O.OOOE+OO 

O.OOOE+OO 

-2.464E-01 

3 

7.S71E-07 

-3.8S2E-01 

-4.119E-27 

O.OOOE+OO 

O.OOOE+OO 

-6.276E-01 

4 

9.034E-07 

-4.343E-01 

-S.711E-27 

O.OOOE+OO 

O.OOOE+OO 

-2.S97E-01 

S 

-3.969E-03 

-4.343E-01 

-7.490E-27 

O.OOOE+OO 

O.OOOE+OO 

1.782E-01 

6 

3.009E-01 

-4.343E-01 

-9.801E-27 

O.OOOE+OO 

O.OOOE+OO 

9.829E-01 

7 

4.022E-01 

-4.343E-01 

-1.04SE-26 

O.OOOE+OO 

O.OOOE+OO 

l.OOSE+00 

8 

1.S49E-07 

-3.043E-02 

-8.062E-28 

O.OOOE+OO 

O.OOOE+OO 

-4.996E-01 

9 

2.409E-07 

-6.8S9E-02 

-1.301E-27 

O.OOOE+OO 

O.OOOE+OO 

-6.922E-01 

10 

3.269E-07 

-1. 171E-01 

-1.786E-27 

O.OOOE+OO 

O.OOOF+00 

-8.2S1E-01 

11 

4. 130E-07 

-1.721E-01 

-2.2S8E-27 

O.OOOE+OO 

O.OOOE+OO 

-8.996E-01 

12 

4.990E-07 

-2.301E-01 

-2.730E-27 

O.OOOE+OO 

O.OOOE+OO 

-9.168E-01 

13 

S.8S1E-07 

-2.874E-01 

-3.202E-27 

O.OOOE+OO 

O.OOOE+OO 

-8.767E-01 

14 

6. 711E-07 

-3.402E-01 

-3.674E-27 

O.OOOE+OO 

O.OOOE+OO 

-7. 794E-01 
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15  1.360E-02  -4.343E-01  -7.833E-27  O.OOOE+00  O.OOOE+00  3.709E-01 

16  4.258E-02  -4.343E-01  -8.174E-27  O.OOOE+00  O.OOOE+00  5.376E-01 

17  8.132E-02  -4.343E-01  -8.515E-27  O.OOOE+00  0,000E+00  6.782E-01 

18  1.282E-01  -4.343E-01  -8.854E-27  O.OOOE+00  O.OOOE+00  7.928E-01 

19  1.815E-01  -4,343E-01  -9.193E-27  O.OOOE+00  0,000E+00  8.815E-01 

20  2.396E-01  -4.343E-01  -9.531E-27  O.OOOE+00  O.OOOE+00  9.442E-01 


JOB: arms  9-MAy-91  MODE  3  —  2.659E+00  CPS  15:39:19  PAGE  1 

DISPLACEMENT  INFORMATION 


POINT 

U 

V  W 

RX 

RY 

RZ 

1 

O.OOOE+00 

O.OOOE+00  O.OOOE+00 

O.OOOE+00 

O.OOOE+OO 

O.OOOE+OO 

2 

-4.969E-07 

5.494E-02  -4.018E-18 

O.OOOE+00 

O.OOOE+OO 

2.014E+00 

3 

-5.466E-06 

3.727E-01  -5.372E-17 

O.OOOE+00 

O.OOOE+OO 

-4.275E+00 

4 

-6.521E-06 

-1.385E-01  -7.411E-17 

O.OOOE+00 

O.OOOE+OO 

-4.782E+00 

5 

-5.142E-01 

-1.385E-01  -9.646E-17 

O.OOOE+00 

O.OOOE+OO 

-3.628E+00 

6 

-3.166E-01 

-1.385E-01  -1.255E-16 

0.000E-^00 

O.OOOE+OO 

5.428E+00 

7 

3.009E-01 

-1.385E-01  -1.336E-16 

O.OOOE+00 

O.OOOE+OO 

6.403E+00 

8 

-1. 118E-06 

2.309E-01  -1.058E-17 

O.OOOE+00 

O.OOOE+OO 

3.306E+00 

9 

-1.739E-06 

4.487E-01  -1.705E-17 

O.OOOE+00 

O.OOOE+OO 

3.367E+00 

10 

-2.360E-06 

6.392E-01  -2.339E-17 

O.OOOE+00 

O.OOOE+OO 

2.517E+00 

11 

-2.981E-06 

7.599E-01  -2.954E-17 

O.OOOE+00 

O.OOOE+OO 

1.267E+00 

12 

-3.602E-06 

7.982E-01  -3.568E-17 

O.OOOE+00 

O.OOOE+OO 

-7.512E-02 

13 

-4.223E-06 

7.486E-01  -4.183E-17 

O.OOOE+00 

O.OOOE+OO 

-1.500E+00 

14 

-4.845E-06 

6.062E-01  -4.796E-17 

O.OOOE+00 

O.OOOE+OO 

-2.997E+00 

15 

-7. 177E-01 

-1.385E-01  -1.008E-16 

O.OOOE+00 

O.OOOE+OO 

-2.753E+00 

16 

-8.601E-01 

-1.385E-01  -1.050E-16 

O.OOOE+00 

O.OOOE+OO 

-1.705E+00 

17 

-9.308E-01 

-1.385E-01  -1.093E-16 

O-OOOE+00 

O.OOOE+OO 

-4.958E-01 

18 

-9. 199E-01 

-1.385E-01  -1.136E-16 

O.OOOE+00 

O.OOOE+OO 

8.632E-01 

19 

-8.183E-01 

-1.385E-01  -1.178E-16 

O.OOOE+00 

O.OOOE+OO 

2.359E+00 

20 

-6.177E-01 

-1.385E-01  -1.221E-16 

O.OOOE+00 

O.OOOE+OO 

3.979E+00 

JOB: arms  9- 

-MAY-91  MODE  4  —  3.552E+00  CPS  15:39:20 

DISPLACEMENT  INFORMATION 

1  PAGE 

POINT 

U 

V  W 

RX 

RY 

RZ 

1 

O.OOOE+00 

O.OOOE+00  O.OOOE+00 

O.OOOE+Oo 

O.OOOE+OO 

O.OOOE+OO 

2 

-1.978E-06 

-6.461E-02  -7.421E-13 

O.OOOE+00 

O.OOOE+OO 

-2.330E+00 

3 

-2. 176E-05 

-9,639E-02  -9.922E-12 

O.OOOE+OO 

O.OOOE+OO 

2.818E+00 

4 

-2. 596E-05 

9.628E-02  -1.369E-11 

O.OOOE+OO 

O.OOOE+OO 

2.391E-01 

5 

-1.943E-01 

9.628E-02  -1.782E-11 

O.OOOE+OO 

O.OOOE+OO 

-3.010E+00 

6 

-4. 788E-01 

9.630E-02  -2.318E-11 

O.OOOE+OO 

O.OOOE+OO 

6.757E+00 

7 

3.414E-01 

9.630E-02  -2.468E-11 

O.OOOE+OO 

O.OOOE+OO 

8.730E+00 

8 

-4.450E-06 

-2.597E-01  -1.954E-12 

O.OOOE+OO 

O.OOOE+OO 

-3.498E+00 

9 

-6.922E-06 

-4.736E-01  -3.150E-12 

O.OOOE+OO 

O.OOOE+OO 

-2.995E+00 

10 

-9.395E-06 

-6.177E-01  -4.320E-12 

O.OOOE+OO 

O.OOOE+OO 

-1.436E+00 

11 

-1.187E-05 

-6.529E-01  -5.456E-12 

O.OOOE+OO 

O.OOOE+OO 

2.636E-01 

12 

-1.434E-05 

-5.924E-01  -6.591E-12 

O.OOOE+OO 

O.OOOE+OO 

1.576E+00 

13 

-1.681E-05 

-4.612E-01  -7.725E-12 

O.OOOE+OO 

O.OOOE+OO 

2.4&7E+00 

14 

-1.928E-05 

-2.853E-01  -8.859E-12 

O.OOOE+OO 

O.OOOE+OO 

2.983E+00 

15 

-4.093E-01 

9.629E-02  -1.862E-11 

O.OOOE+OO 

O.OOOE+OO 

-3.639E+00 

16 

-6.409E-01 

9.629E-02  -1.941E-11 

O.OOOE+OO 

O.OOOE+OO 

-3.532E+00 

17 

-8.426E-01 

9.629E-02  -2.020E-11 

O.OOOE+OO 

O.OOOE+OO 

-2.702E+00 

18 

-9.691E-01 

9.629E-02  -2.099E-11 

O.OOOE+OO 

O.OOOE+OO 

-1. 167E+00 

19 

-9.764E-01 

9.630E-02  -2.177E-11 

O.OOOE+OO 

O.OOOE+OO 

1.050E+00 

20 

-8.219E-01 

9.630E-02  -2.256E-11 

O.OOOE+OO 

O.OOOE+OO 

3.925E+00 

JOB:arm5  9-MAY-91  MODE  5  —  6.129E+00  CPS  15:39:20  PAGE  1 

DISPLACEMENT  INFORMATION 

POINT  U  V  W  RX  RY  RZ 

1  O.OOOE+00  O.OOOE+00  0,000E+00  O.OOOE+00  O.OOOE+00  O.OOOE+00 

2  -1.587E-06  1.130E-01  3.628E-16  O.OOOE+00  O.OOOE+00  3.885E+00 
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3 

-1.746E-05 

-6.445E-01 

4.931E-15 

O.OOOE+00 

O.OOOE+00 

5.642E+00 

4 

-2.083E-05 

1.459E-01 

6.886E-15 

O-OOOE+00 

O.OOOE+00 

6.691E+00 

5 

4.542E-01 

1.459E-01 

9.133E-15 

O.OOOE+00 

O.OOOE+00 

l,199E+00 

6 

-1.567E-01 

1.460E-01 

1.205E-14 

0,000E+00 

O.OOOE+00 

1.417E+00 

7 

7.650E-02 

1.460E-01 

1.288E-14 

O-OOOE+00 

O.OOOE+00 

2.733E+00 

8 

-3.571E-06 

3,975E-01 

9-561E-16 

O.OOOE+00 

O.OOOE+00 

4.293E+00 

9 

-5.555E-06 

5.800E-01 

1.544E-15 

O.OOOE+00 

O.OOOE+00 

1.004E+00 

10 

-7.539E-06 

4.984E-01 

2.123E-15 

O.OOOE+00 

O.OOOE+00 

-3.540E+00 

11 

-9.523E-06 

1.609E-01 

2.690E-15 

O-OOOE+00 

O.OOOE+00 

-6.641E+00 

12 

-1.151E-05 

-2.880E-01 

3.257E-15 

O.OOOE+00 

O-OOOE+00 

-7.049E+00 

13 

-1.349E-05 

-6.774E-01 

3.824E-15 

O.OOOE+00 

O.OOOE+00 

-4.767E+00 

14 

-1.547E-05 

-8.373E-01 

4.390E-15 

O.OOOE+00 

O.OOOE+00 

1.696E-01 

15 

4.635E-01 

1.459E-01 

9.565E-1S 

O.OOOE+00 

O.OOOE+00 

-7.967E-01 

16 

3.670E-01 

1.460E-01 

9.996E-15 

O.OOOE+00 

O.OOOE+00 

-2.128E+00 

17 

2.080E-01 

1.460E-01 

1.043E-14 

O.OOOE+00 

O.OOOE+00 

-2.764E+00 

18 

3. 123E-02 

1.460E-01 

1.086E-14 

O.OOOE+00 

O.OOOE+00 

-2.683E+00 

19 

-1.174E-01 

1.460E-01 

1.128E-14 

O.OOOE+00 

O.OOOE+00 

-1.877E+00 

20 

-1.919E-01 

1.460E-01 

1.171E-14 

O.OOOE+00 

O.OOOE+00 

-3.489E-01 

JOB: arms  9- 

-MAY-91  MODE  6  —  1.669E+01  CPS  15:39:20 

DISPLACEMENT  INFORMATION 

1  PAGE 

POINT 

U 

V 

W 

RX 

RY 

RZ 

1 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

2 

-2.502E-06 

4.201E-01 

-1.665E-10 

O.OOOE+00 

O.OOOE+00 

1.237E+01 

3 

-2.750E-05 

3.589E-01 

-2.232E-09 

O.OOOE+00 

O.OOOE+00 

2.310E+00 

4 

-3.280E-05 

-2.598E-02 

-3.084E-09 

O.OOOE+00 

O.OOOE+00 

-6.379E+00 

5 

-6.684E-01 

-2.601E-02 

-4.025E-09 

O.OOOE+00 

O.OOOE+00 

-4.134E+00 

6 

1.220E-01 

-2.611E-02 

-5.246E-09 

O.OOOE+00 

O.OOOE+00 

6.290E-01 

7 

-2.433E-02 

-2.613E-02 

-5.587E-09 

O.OOOE+00 

O.OOOE+00 

-2.474E+00 

8 

-5.630E-06 

9.551E-01 

-4.385E-10 

O.OOOE+00 

O.OOOE+00 

5.754E-01 

9 

-8.757E-06 

3.730E-01 

-7.071E-10 

O.OOOE+00 

O.OOOE+00 

-1.690E+01 

10 

-1.188E-05 

-7.914E-01 

-9.703E-10 

O.OOOE+00 

O.OOOE+00 

-1.545E+01 

11 

-1.501E-05 

-1.353E+00 

-1.226E-09 

O.OOOE+00 

O.OOOE+00 

-2.824E+00 

12 

-1.813E-05 

-1.231E+00 

-1.481E-09 

O.OOOE+00 

O.OOOE+00 

5.951E+00 

13 

-2.126E-05 

-6.937E-01 

-1.737E-09 

O.OOOE+00 

O.OOOE+00 

1.017E+01 

14 

-2.438E-05 

-4.728E-02 

-1.992E-09 

O.OOOE+00 

O.OOOE+00 

9.311E+00 

15 

-8.606E-01 

-2.603E-02 

-4.206E-09 

O.OOOE+00 

O.OOOE+00 

-1.850E+00 

16 

-8.995E-01 

-2.604E-02 

-4.387E-09 

O.OOOE+00 

O.OOOE+00 

6.154E-01 

17 

-7.887E-01 

-2.606E-02 

-4.566E-09 

O.OOOE+00 

O.OOOE+00 

2.786E+00 

18 

-5.617E-01 

-2.607E-02 

-4.746E-09 

O.OOOE+00 

O.OOOE+00 

4.202E+00 

19 

-2.786E-01 

-2.609E-02 

-4.925E-09 

O.OOOE+00 

O.OOOE+00 

4.500E+00 

20 

-1.872E-02 

-2.610E-02 

-5.103E-09 

O.OOOE+00 

O.OOOE+00 

3.449E+00 

B.  FORTRAN  PROGRAM  FORM 


PROGRAM  FORM 

C 

C  AUTHOR:  R.  J.  WATKINS 
C 

C  DATE:  MAY  18,  1991 
C 

C  THIS  PROGRAM  READS  IN  DATA  GIVEN  BY  GIFTS  OUTPUT  AND 
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noon  no 


PUTS  IT  INTO  A  FORMAT  FOR  STATE-SPACE  MODELING 

DOUBLE  PRECISION  A(I6,16),  B(16),  AI,  BI 

REAL  OMEGA(6),U(6,20),V(6,20),PSX(20),PSY(20),MS(20),IZZ01 

1,DS(6),  ES(6),  FS(6),  GS(6),  IW,  IZZ02,HS(6),JS(6) 

OPEN  (UNIT=10,  FILE=’RESXDAT.LPT’,  STATUS  = ’OLD’) 

OPEN  (UNIT=11,  FILE=’PS.DAT’,STATUS  =  ’OLD’) 

OPEN  (UNIT=12,  FILE=’MS.DAT’,STATUS  =  ’OLD’) 

OPEN  (UNIT=I3,  FILE=’CHECK.DAT’,status  =  ’new’) 

OPEN  (UNIT=14,  FILE=’ADMP’,status=’new’,CARRIAGECONTROL=’LIST’) 
OPEN  (UNIT=15,  FILE=’BDMP’,status=’new’,CARRIAGECONTROL=’LIST’) 

READ  IN  OUTPUT  FROM  PR  OUT  BATCH  FILE 


READ(10,5) 

5  FORMAT  (///) 

DO  6  1=1,6 

READ(10,7)  OMEGA(I) 

6  CONTINUE 

7  FORMAT  (lOX, El  1.5) 

DO  12  1=1,6 

READ(10,5) 

DO  15  J=l,20 

READ(10,13)  U(I,J),  V(I,J) 

15  CONTINUE 

12  CONTINUE 

13  FORMAT(7X,Ei0.3,lX,E10.3) 

C 

C  READ  TN  MS  AND  PS  DATA  FILES 

C  PS  IS  POSITION  OF  EACH  NODE  (SUBBODY)  IN  METERS 
C  AND  MS  IS  THE  MASS  OF  EACH  SUBBODY  IN  KG.  NOTE  1:  FIRST 
C  ENTRY  IN  MS. DAT  IS  THE  INERTIA  TERM  FOR  THE  SYSTEM  (IZZOl) 
C  NOTE  2;  MASS  AND  POSITION  OF  EACH  NODE  MUST  BE  IN  SAME 
C  SEQUENCE  AS  OUTPUT  IN  PR  OUT  FILE!! 

C 

DO  20  1  =  1,20 

READ  (11,-^)  PSX(I),  PSY(l) 

20  CONTINUE 

READ  (12,*)  IZZOl 
DO  30  1  =  1,20 

READ  (12,*)  MS(1) 

30  CONTINUE 
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non 


C  FORM  THE  TERMS  FOR  THE  A  AND  B  MATRIX.  ALSO  CALCULATE 
C  CHECK  MATRIX  ES;  ALL  ENTRIES  SHOULD  BE  APPROX  I  IF 
C  DATA  INPUT  CORRECTLY.  OUTPUT  IS  IN  CHECK.DAT  (ASCII) 

C  INPUT  DAMPING  FOR  ARM  (ZETA)  NOTE:  COULD  BE  CHANGED 
C  TO  VECTOR  IF  NECESSARY 
C 

ZETA =0.02 
IZZ02=IZZ01 
DO  35  1  =  1,6 
DSa)=0.0 
ESa)=0.0 
DO  32  J  =  l,20 

DS(I)=DS(I)  +  (Va,J)*PSX(J)-U(I,J)*PSY(J))*MS(J) 
ES(I)=ES(I)+(U(I,J)**2+V(I,J)**2)-^MS(J) 

32  CONTINUE 

WRITE(13,-^)  ES(I) 

IZZ02 =IZZ02-DS(I)’^-^2 
35  CONTINUE 
DO  38  1  =  1,6 

FS(I)=DSa)="OMEGAa)**2 

GS(I)=(0MEGAa)**2)*IZZ02+DS(I)*FS(I) 

HS(1) =2.0*OMEGAa)*ZETA*DSa) 
JS(I)=2.0*ZETA*OMEGAa)*IZZO2+DS(I)*HS(I) 

38  CONTINUE 

FORM  A  AND  B  MATRIX 

DO  45  1  =  1,14 
DO  42  J=l,14 
A(I,J)=0.0 
42  CONTINUE 
45  CONTINUE 
DO  50  1  =  1,7 
A(I,I+7)  =  1.0 
50  CONTINUE 
DO  57  1=2,7 

A(8,I)=FS(M)/IZZ02 
57  CONTINUE 
DO  65  1=9,14 
DO  60  J=2,7 

Aa,J)=-DS(I-8)*FS(J-l)/IZZ02 
60  CONTINUE 
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UUU  UUUOCJU  uuu 


DO  63  J=9,14 

Aa,J)=-DSa-8)*HS(J-8)/IZZ02 
63  CONTINUE 

A(l,I)=-JS(I-8)/IZZ02 
A(8,I)=HSa-8)/IZZ02 
A(l,I-7)=-GSa-8)/IZZ02 
65  CONTINUE 

FORM  CONTROL  INPUT  MATRIX  B 

DO  70  1  =  1,7 
BO)  =0.0 
CONTINUE 
B(8)  =  1.0/IZZO2 
DO  75  1=9,14 

B(I)=-DS(I-8)/IZZ02 
CONTINUE 

WRITE  MATRIX  TO  FILES.  USE  MATRIXX  SUBROUTINE  MATSAV  TO 
CONVERT  DATA  INTO  READABLE  FORM  FOR  MATRIXX.  OUTPUT 
IS  IN  ADMP  AND  BDMP. 


CALL  MATSAV(14, ’AS YS’,  16, 14, 14,0,A,AI,’(1P2E24. 15)’) 
CALL  MATSAV(15,’BSYS’,  16, 14,1,0, B,BI,’(1P2E24. 15)’) 

END  OF  PROGRAM 

STOP 

END 
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APPENDIX  D 


The  following  table  is  reprinted  for  convenience: 


TABLE  IV  Weighting  Factors 


Rxx 

Ruu 

Designation 

D 

qi 

q2 

D 

qi 

q2 

T 

Cl 

D 

0 

0 

0 

0 

0 

.001 

C2 

1 

10 

10 

0 

0 

0 

0.1 

C3 

1 

10" 

10" 

0 

0 

0 

0.1 

C4 

1 

0 

0 

0 

1 

1 

0.1 

C5 

1 

0 

0 

0 

10" 

10" 

0.1 

C6 

1 

0 

0 

1 

0 

0 

0.1 

C7 

D 

0 

0 

1 

0.2 

0.2 

100 

C8 

D 

0 

0 

1 

0.7 

0.5 

1000 
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Figure  51  Impulse  Response,  PD2 


Figure  52  Impulse  Response,  PD3 
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Figure  54  Bias  Maneuver,  Cl 
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Figure  55  Slew  Maneuver,  C2 


Figure  56  Slew  Maneuver,  C2 
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Figure  57  Slew  Maneuver,  C3 


Figure  58  Slew  Maneuver,  C3 


72 


«(() 


Figure  59  Slew  Maneuver,  C4 


Figure  60  Slew  Maneuver,  C4 
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Figure  61  Slew  Maneuver,  C5 


Figure  62  Slew  Maneuver,  C5 
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Figure  63  Slew  Maneuver,  C6 


Figure  64  Slew  Maneuver,  C6 
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Figure  65  Slew  Maneuver,  C7 


Figure  66  Slew  Maneuver,  C7 
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